#! /bin/bash

rostopic echo /DC_Motor_Left_Speed&
rostopic echo /DC_Motor_Right_Speed&
rostopic echo /right_inner/command&

while [ 1 == 1 ]

do
echo "Dynamixel-Rosserial-IR-Magnetometer-Openni"
echo " Dynamixel:"
rostopic echo /motor_states/pan_tilt_port -n 1&
sleep 1
echo "Rosserial:"
rostopic echo /Rosserial_Diag -n 1&
sleep 1
echo " IR:"
rostopic echo /IRSensor -n 1&
sleep 1
echo " Magnetometer"
rostopic echo /Magnetometer -n 1&
sleep 1

echo "Depth Image"
rostopic hz /camera/depth/image_raw -w 30&
sleep 3

echo "Local - Path - Planning"
echo "Direction control:"
rostopic echo /direction_control -n 1&
sleep 1


sleep 5

done
